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RESUMEN 

El siguiente artículo se estudiara a detalle la realización del proceso de modelado de un 
manipulador robótico en configuración antropomórfica con tres articulaciones de revolución o 
revolutas, correspondientes a tres grados de libertad «3DoF», está vez partiendo de una posición 
especifica del manipulador y su ubicación en el plano. Desde este punto entonces, el modelo 
será desarrollado mediante el uso de software, específicamente Matlab, en su entorno simulink 
haciendo uso de la librería de modelado físico simscape, ramal SimMechanics «primera 
generación». En este programa, se podrá ilustrar el manipulador previamente citado en una 
secuencia de bloques, en donde es posible añadírsele: leyes naturales como el vector de 
gravedad, elementos actuadores como motores que generan torque en las articulaciones, 
elementos sensores como multímetros para poder registrar la velocidad angular, posición y 
aceleración angular de las articulación que se deseen monitorear y además la posibilidad de 
realizar un control mediante bloque PID 


Palabras Clave: Matlab, simulink, simscape, simechanics, modelado, manipuladores, 
antropomórfico, grados de libertad. 


ABSTRACT 


In this article we studied to detail the realization of the process of modeling about a robotic 
manipulator in anthropomorphic configuration with three revolute or revolution articulations, 
for to three degrees of freedom «3DoF», this time was starting of the one specific position of the 
manipulator and its location in the plane. From that point then, the model was developed 
through the use of software, specifically Matlab, in its environment simulink to make use of the 
library about physical modeling simscape, branch simechanics «first generation». In this 
program, it's possible illustrate previously cited manipulator in a sequence of blocks, in where 
1s possible add; nature laws like the gravity vector, actuators like motors that generates torque in 
the articulations, sensors as scopes for to register the angular velocity, position and angular 
acceleration of the articulations that want be monitored and also the possibility of realizing a 
control through PID block. 


Keywords: MATLAB, Simulink, Simscape, simechanics, modeling,  manipulative, 
anthropomorphic, degrees of freedom 
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1. INTRODUCCIÓN 


El proceso de modelado robótico consiste en la caracterización del movimiento de las 
articulaciones de este, en ecuaciones ordinaras, diferenciales o integrales según sea la 
naturaleza del movimiento. Este proceso puede ser más o menos complejo dependiendo 
directamente del número de articulaciones y del tipo de análisis que se quiere lograr, sea 
cinemático o dinámico. Cuando el modelado que se quiere lograr es dinámico y el 
número de articulaciones es mayor o igual a tres, adquiere un nivel de dificultad que 
hace necesario entonces el uso del software. 


Afortunadamente, cada día son más los programas y algoritmos computaciones que 
existen para poder realizar este tipo de análisis, donde solo es necesario un sencillo 
estudio analítico y procedimental conocido como “Algoritmo de Denavit-Hartenberg”, 
que ofrece finalmente una tabulación de datos primordial para iniciar el modelado. 


Uno de los más populares programas entonces para el modelado robótico es Matlab, que 
ya sea con el uso de toolbox o de sus librerías de origen, en el entorno simulink es 
posible realizar la implementación de un esquema que emula manipuladores robóticos, 
donde es posible estudiar el movimiento, calcular controladores, entre otras. Simscape, 
es la librería multidomino para modelados físicos, siendo entonces el ramal de 
SimMechanics el que especializada en manipuladores robóticos y de cual se estudiar 
más a fondo en el desarrollo del artículo. 


El presente paper, está estructurado de la siguiente manera: en la sección II se presenta 
todo el desarrollo de la investigación: el punto de partida del modelado desde el 
algoritmo D-H hasta la configuración bloque a bloque en el entorno de simulink. En la 
sección III se presentan los resultados y discusión del funcionamiento. En la sección IV 
se presentan las conclusiones y finalmente, en la sección V las Referencias 
Bibliográficas. 


TT. DESARROLLO 


Para iniciar el proceso de modelado, primeramente haremos una descripción escrita, del 
manipulador para tener clara su estructura física. 


Análisis del Sistema 


Comenzando por la base fija que contiene una articulación revoluta, a la que 
llamaremos «hombro». Al hombro entonces, le sigue un eslabón al que se llamara 
«antebrazo» y que contiene otra articulación revoluta que será el «codo». Al codo le 
sigue el siguiente elemento «brazo» y que contiene entonces la última articulación 
«muñeca». La muñeca une al brazo con el efector final que será establecido entonces 
como la «mano». Estas convenciones establecidas emulan la estructura de un brazo 
humano (Granados y col, 2013). 


Ahora bien, para comenzar el proceso de colocación en simulink, vamos a estudiar los 
bloques de SimMechanics, que nos permitirán armar el sistema anteriormente descrito, 
Tabla 1. 
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Tabla 1. Bloques necesarios de SimMechanics 


Bloque Descripción 
Env > ] . ; 
nm Este bloque introduce en nuestros esquemas el efecto de medio ambiente, tales 
Environment como la gravedad (Jaramillo, 2010). 
Entorno 
bb Este bloque representa un punto de tierra inmóvil en reposo en el sistema de 
ud referencia inercial mundial absoluta. También es un tipo de cuerpo, pero se 
puede conectar solo un punto de la tierra a alguna articulación (Jaramillo, 2010). 
Tierra 
jes fpcsz |a Un bloque de cuerpo, representa un cuerpo rígido con propiedades configurables. 
iaR? Entre lo que se puede configurar esta, la masa, momento de inercia, centro de 
Enlace gravedad, entre otros. 
| El bloque revoluta, represe un grado de libertad rotacional, con eje de giro en un 
REVOME alguno de los ejes de coordenadas, entre dos cuerpos (Gallo, 2007). 
Articulacion 
Representa una fuerza que depende del tiempo, torque, o movimiento de entrada 
Á para una articulación. El bloque del actuador, acciona un bloque conjunto 
167] conectado entre dos cuerpos con una de estas señales: Fuerza por movimiento 
ES traslacional en caso de articulaciones prismáticas. Torque por movimiento 
rotacional alrededor en caso de una articulación de revolución (Ljung y Glad, 
1994). 
Actuador 
| y» El bloque sensor mide la posición, velocidad y la aceleración de una articulación 
Joint Sensor primitiva o un bloque de articulación. También mide la reacción de la fuerza y el 
torque y un par de articulación (Hunt et al,2001). 
Sensor 


Caracterización en Bloques 


Al haber analizado la descripción del sistema y los bloques necesarios para plasmarlo en 
el entorno simulink, finalmente queda de esta manera ver Figura 1 (Albites, 2010). 


f pr 
Jue 
Env [o 


Entorno 
Figura 1. Manipulador Robótico expresado en bloques. 
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Ubicación Espacial 


Lo siguiente será la configuración bloques al bloque del sistema anterior, para darle 
forma en el espacio. Para esto es necesario ubicarlo espacialmente, asumiendo una 
posición fija del manipulador, además de marcar las coordenadas de los puntos 
entremos y centros de gravedad de cada articulación en el plano ver Figura 2. 
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(0.5,0,1.0) (1,0,1) 


(0.25,0,1) 
(,5,0,1) (0.75,0,1) 
L] 


(0,0,0.5) 


Figura 2. Ubicación Espacial 


Configuración Bloque a bloque 


Bloque Entorno: 


Este bloque representa la influencia del medio ambiente en sistema, en este caso, este 
bloque servirá para introducir el efecto de la gravedad (Craig ,2006). El efecto de 


gravedad debe ser introducido 


Fi Block Parameters: Machine Environment A [--] 


como un vector. Figura 3. 


th 


Description 


Defines the mechanical simulation environment for the machine to which 


solver type, tolerances, linearization, and visualization. 


e block is connected: gravity, dimensionality, analysis mode, constraint 


| Parameters | Constraints | Linearization | Visualization 


| Analysis mode: Type of solution for machine's motion. 
Tolerances: Maximum permissible misalignment of machine's joints. 


|| | Gravity vector: [o -9.81 0] m/st2 y 
[7 Input gravity as signal 
| Machine dimensionality: [Auto-detect Ñ ] 
Analysis mode: [Forward dynamics 5 ] 
W 
Linear assembly tolerance:  1e-3 (mv) 
Angular assembly tolerance: 1e-3 
¡Ang y 
Configuration Parameters... 


Help) (_ApW 


Figura 3. Configuración de Entorno 
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Bloque Referencia: 


Este bloque corresponde al punto de referencia inicial, como un punto fijo en el suelo 
(López y Apostolovich, 2010). Es importante destacar el hecho de que, este primer 
punto de referencia debe actuar con la influencia del entorno y para hacer esto posible 
debe marcarse la opción «Show Machine Environment Port», Figura 4. 


fr 
*j Block Parameters: Referencia [oe 


Ground 


Grounds one side of a Joint to a fixed location in the World 
coordinate system. 


Parameters 


Location [x,y,z]: [O 0 0] mm y 


[Y] Show Machine Environment port 


ant | Cancel Ml Help ] 


Figura 4. Configuración de Bloque Base 


Bloque Hombro: 


Este bloque representa la primera articulación. Para las articulaciones solo es necesario 
activar el eje de giro, introduciendo un vector en donde la componente del eje de giro 
sea el elemento unitario y los otros dos nulos (Barrientos y col, 2007). 


Current base: GNDGQBase 
Current follower: CS1GAnteBrazo 

O) 
Number of sensor / actuator ports: 0 a 


Parameters 


Axes | Advanced | 


Name Primitive 


R1 revolute | Ba | 


Figura 5. Configuración de Articulación Hombro 


Bloque Antebrazo: 


Este bloque corresponde al primer elemento móvil eslabón (Maldonado del Toro y col, 
2011). En este bloque se puede configurar la masa del mismo y la inercia, también 
donde va a estar ubicada su planta CS1, su tope CS2 y el centro de Gravedad CG. Para 
este eslabón, se asumirá una longitud de 10 cm y este ubicado en el origen, Figura 6. 
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| a My 
Fi Block Parameters: AnteBrazo 5 


Body 
Represents a user-defined rigid body. Body defined by mass m, 
inertia tensor 1, and coordinate origins and axes for center of gravity 
(CG) and other user-specified Body coordinate systems. This dialog 
sets Body initial position and orientation, unless Body and/or 
connected Joints are actuated separately. This dialog also provides 
optional settings for customized body geometry and color. 


Mass properties 


Mass: 

Inertia: eye(3) 

Position | Orientation | Visualization 

Show Port Origin Position use] 
Port Side E Vector [x y z] e 

[Bottom y | CG [o 0 0.05] > 

7] csi [000] m 

Y] Top cs2 [000.1] m 

4 | ” ] » 


Apply 


Figura 6. Configuración de Bloque antebrazo 


Otra observación importante, es establecer en cada eslabón, como sistema de 
referencias, el mundo «World» (Pinto y col,2011), Figura 7. 


Position Orientation | Visualization 


Origin Position Translated from 
Vector [x y z] 


[000] m_s[wne > 
CE 


[o 0 0.1] 


Figura 7. Fijación de referencias 
Bloque Codo y Muñeca: 


Estos bloques representan respectivamente las articulaciones 0, y 93 y se configuran 
exactamente con los mismos parámetros de configuración (Marchand y Holland , 2003). 
A diferencia de la primera articulación, su eje de giro es el eje Y, Figura 8. 


Parameters 


Advanced 


Primitive Axis of Action [x y 2] 
revolute [o 1 0] 


Figura 8. Eje de Articulaciones codo y muñeca 
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Bloque Brazo: 


La posición inicial en la que se configurara el brazo es acostado a una altura de 10 cm, 
sostenido por el antebrazo. La dimensión de este se debe definir en el eje X, para el 
extremo derecho CS2, Figura 9. 


Position Orientation | Visualization 
Show Port a Origin Position 
Side Vector [x y z] 


Port 
Ji EMT > E 


[Left + |csi [000.1] mo” 


Y] 
Y] Right y|cs2  [0.0500.1] moy 


Figura 9. Configuración de Bloque Brazo 


Bloque Mano: 
El bloque mano, el cual representa al efector final, como no tiene ningún elemento 
conectado a su derecha, en la configuración se debe desmarcar este puerto y se 


configura en SimMechanics así, Figura 10. 


Position Orientation | Visualization | 


Show Port REE Origin Position 
Port Side Vector [x y z] 


0 ltefe [có  [0.07500.1] mo 
Y (left +|csi  [o.0500.1] m7 
[Right w|cs2  [0.100.1] mo 


Figura 10.Configuración de bloque mano. 


Units 


De esta manera, ya nuestro manipulador robótico queda ubicado espacialmente en el 
entorno de simulink mediante los bloques de la librería simechanics. Ahora, con 
intención de añadir movimiento y observar sus resultados, se hacen necesario añadir 
dos bloques estudiando que aún no se habían usado, como lo son el actuador y el 
sensor (Marchand y Holland , 2003). 


Sensores y Actuadores 


Para añadir movimiento a las articulaciones del manipulador es necesario colocar 
actuadores, los cuales simbólicamente van a representar a los motores que permitirán a 
los eslabones adquirir las distintas posiciones en un rango que previamente se determinó 
(Luces,2015). 


Recordando que, se tienen tres articulaciones de rotación conocidas como: hombro, 
codo y muñeca. Al darle doble clic a estos bloques, aparecerá la ventana de 
configuración del mismo, en donde se debe modificar la opción «Number of 
Sensor/actuador ports» incrementando en 2 (Kelly y Santibáñez,2003), un puerto para 
actuador y un puerto para sensor como en Figura 11. 


») 


Number of sensor / actuator ports: 2 


4) 


Parameters 


| Axes | Advanced | | 
Figura 11.Puertos para actuadores y sensores 
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Configuración de Actuadores 


Es conocido el hecho, que en este sistema manipulador, las tres articulaciones son de 
revolución, por lo tanto la fuerza que debe ejercer el actuador debe ser de movimiento y 
no una fuerza generalizada, que se utiliza en caso de articulaciones prismáticas (Romero 
,2012). De esta manera, se debe modificar el parámetro «Actuate With» con la opción 
«Motion». En panel de configuración de los actuadores, también se seleccionan las 
unidades de ángulo o posición, velocidad angular y aceleración a conveniencia. Este 
proceso es análogo para todas las articulaciones, ver Figura 12 (Murray et al.1994). 


Py Block Parameters: Joint Actuatorl [més 


Joint Actuator 


Actuates a Joint primitive with generalized force/torque or 
linear/angular position, velocity, and acceleration motion signals. 
Base-follower sequence and joint axis determines sign of forward 
motion. Inputs are Simulink signals. Motion input signals must be 
bundled into one signal. Connect to Joint block to see Connected to 


primitive list. 
Actuation 

Connected to 

primitive: (ei DA 
Actuate with: 

Generalized Forces 
Angular units: [deg- y) 
Angular velocity units: (rad/s e y) 


Angular acceleration units: (rad/s?2 Ñ ] 


[_ Cancel] Help ) Apply 
Figura 12.Configuración de Actuadores 


El actuador con movimiento, requiere entonces tres señales distintas para cada variable: 
ángulo, velocidad angular y aceleración angular, las cuales deben ser colocados con 
ayuda de un bloque MUX. Asumiendo que la velocidad es constante, implica que la 
aceleración debe ser nula, y la posición será una secuencia fijada según los límites de 
cada articulación (Piñero y Velásquez , 2010). 


Joint Sensor 


Hombro 


Joint Actuator 


Figura 13.Etapa de Actuador de Articulacion 


Respecto a las secuencias de las señales para cada articulación, se fijara un tiempo total 
t = 155, en el que cada articulación podrá recorrer el rango por el cual está delimitada 
[19], viéndose las configuraciones de estas en ver: Figura 14, Figura 15 y Figura 16. 
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*jí Source Block Parameters: Señal Theta 1 i de 7] 
Repeating table (mask) (link) 


Output a repeating sequence of numbers specified in a table of time-value 
pairs. Values of time should be monotonically increasing. 


Parameters 


Time values: 


Output values: 
[0 24 48 72 96 120 144 168 192 216 240 264 288 312 336 360] 


9 Apply 
Figura 14. Secuencia de Control para 0, 


*y Source Block Parameters: Señal Theta 2 . _S] 
Repeating table (mask) (link) 


Output a repeating sequence of numbers specified in a table of time-value 
pairs. Values of time should be monotonically increasing. 


Parameters 


Time values: 


Output values: 
[o -90 -180 -90 0] 


[e] APD 
Figura 15.Secuencia de Control para 0, 


[Fiyi Source Block Parameters: Señal Theta 3 [só] 
Repeating table (mask) (link) 


Output a repeating sequence of numbers specified in a table of time-value 
pairs. Values of time should be monotonically increasing. 


Parameters 


Time values: 


Output values: 
[o 90 0 -90 0] 


Y App 
Figura 16.Secuencia de Control para 03 


Configuración de Sensores 


Para la configuración de los bloques sensores, se activan las variables que sean de 
interés conocer con sus respectivas unidades. Figura 17. 
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"ji Block Parameters: Joint Sensort == 


Joint Sensor 


Measures linear/angular position, welocity, acceleration, computed 
force/torque and/or reaction force/torque of a Joint primitive. 
Spherical measured by quaternion. Base-follower sequence and 
joint axis determine sign of forward motion. Outputs are Simulink 
signals. Multiple output signals can be bundied into one signal. 
Connect to Joint block to see Connected to primitive list. 


Measurements 


Primitive Outputs 


Connected to 


primitive: [ra a) 
angie Units: 
Angular velocity Units: |deg/s > 
1 Angular acceleration Units: deg/s”2 > 
[A Computed torque Units: N=m — 
Joint Reactions 

E Reaction torque Units: N=m - 
EJ Reaction force Units: |N e 
Reaction measured (a =] 
on: 

wvith respect to Cs: [Absolute (World) +) 


Output selected parameters as one signal. 


cancel) (o nele >) [apply 
Figura 17.Configuración de Sensores 


A la salida del sensor se coloca un elemento de visualización tal como el «Scope», para 
el monitoreo de los ángulos en este caso. Figura 18. 


Figura 18.Etapa de medición de posición de Articulación 


Configuración de Simulación 


Antes de simular es importante la configuración de un par de parámetros como: 


Tiempo de simulación 


El tiempo de simulación, se establecerá de 15 segundos, en el cual será posible observar 
el desplazamiento completo de cada articulación [20]. Cabe destacar, que no hace falta 
añadir factor de aceleración al tiempo, ver Figura 19. 


Help 
y 30.0 


Accelerator 
Rapid Accelerator 

Software-in-the-Loop (SIL) 
Processor -in-the-Loop (PIL) 
External 


ind drag. More information. 
Figura 19.Tiempo de Simulación 
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Activación de Animación 


Para poder observar el movimiento durante la simulación, es necesario marcar unas 
opciones accediendo a simulation — Model configuration Parameters y una vez allí en 
la pestaña SimMechanics 1G (Albites y col,2010), se seleccionan las casillas que se 
puede observar en la Figura 20. 


¿£) Configuration Parameters: Bloques_Simple/Configuration (Active) 


Select: | SimMechanics First Generation (1G) configuration parameters: 
Solver Diagnostics 
Data Import/Export : 
Optimization [Y] warn if machine contains redundant constraints 
Disgnosties , 1] Warn if number of initial constraints is unstable 
Hardware Implementation 2 
Model Referencing [7] Mark automatically cut joints 
Simulation Target 
Code Generation Visualization 
HDL Code Generation A 
Simscape | [Z] Display machines after updating diagram 
SimMechanics 2G | [Y] Show animation during simulation 
[Y] Show only port coordinate systems 


Default body color (RGB): [1;0;0;] 


Default body geometries: [Convex hull from body CS locations Si 


| 
Figura 20.Otros parámetros de Simulación. 


HI. RESULTADOS Y DISCUSIÓN 


Pruebas Individuales 


En el apartado Luces (2015), es posible encontrar un conjunto de pruebas más extenso y 
desarrollado, en este artículo, vamos a revisar el funcionamiento mediante el grafico de 
posición en el tiempo. Para la realización de las pruebas individuales se anulas las 
velocidades de las demás articulaciones, dejando solo activa la que nos interesa probar. 


Articulación 0, 


PES 


Figura 21.Gráfico de Posición 0, 


De acuerdo la Figura 21, se puede apreciar que el eslabón 1 vuelve a su posición 
original, como fue diseñado haciendo un recorrido de O a 271. Es decir, La articulación 
en cuestión tiene total libertad de movimiento haciendo una revolución completa en un 
tiempo de 15 segundos, como se puede apreciar en el gráfico de posición. 


Ciencia e Ingeniería 2015 Vol. (2) N* (2) Velásquez S., Luces J. y Velásquez R. 


MODELADO Y SIMULACIÓN DE UN BRAZO ROBÓTICO MEDIANTE EL USO DE SIMMECHANICS DE MATLAB 


Articulación 0, 


¡Sitio z His. 
ac Es; 0mRADGr > 


Figura 22. Gráfico de Posición 0, 


De acuerdo a la Figura 22, la segunda articulación tiene un desplazamiento de 0 a Tx, lo 
que corresponde a media revolución. En la mitad del tiempo esta articulación, completa 


la el recorrido y en la mitad restante se posiciona nuevamente en su posición original. 


Articulación 603 


7 di 
ao Reir > 


Figura 23.Gráfico de Posición 03 


De acuerdo a la Figura 23, se puede ver el rango de trabajo de la articulación es de A a 


3 . TU TU . e . á 
¿TO lo mismo que 32-31, completando media revolución, en la mitad del tiempo y en 


la otra mitad, se devuelve a su posición original. 


Pruebas del Sistema completo 


Ahora que se han probado una por una, en la siguiente fase de la prueba funcionaran 


todas las articulaciones simultáneamente. 
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Esta prueba da fidelidad de la coherencia mecánica que deben tener las piezas para no 
colisionar durante alguno de los ángulos de acción de las articulaciones. 


IV. CONCLUSIONES 


Existen variados software que permiten la realización de un modelado robótico. 

El proceso de modelado robótico es el punto de inicio para un proceso más extenso e 
importante como lo es el diseño completo de un robot, de manera que, a través del 
modelado se estudian a detalle el funcionamiento de las articulaciones y sus 
posibilidades de movimiento, que van a depender de la necesidad de la actividad que se 
requiera realizar. 


Los brazos robóticos, están basados idealmente en el funcionamiento de los brazos 
humanos, con la posibilidad de poder agregar, mayor fortaleza y robustez para la 
realización de diversas acciones. 

Es importante propulsar el desarrollo robótico, ya que esta rama de la tecnología es de 
gran importancia especialmente en los procesos industriales, donde es requerido el 
trabajo pesado, y una precisión y exactitud sobrehumana. 
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